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Abstract - This paper presents a new tool based on DSmT 
( Dezert-Smarandache Theory) and fast-Hough self-localization 
which is applied to autonomous mobile robot’s map 
reconstruction. Uncertainty' from sonar information is fused and 
managed in rebuilding grid map effectively with DSmT, since 
fast-Hough self-localization from laser information overcomes 
some shortcomings of classical Hough transformation including 
high amount of computation and low precision of localization. 
When a virtual mobile robot evolves in the virtual environment 
with different outline features, the result can adequately testify 
that the new tool owns better performance to rebuild map. In 
general, this research provides an approach for studying 
autonomous navigation of mobile robot or unmanned land 
vehicle (ULV) in unknown environment, also provides a human- 
computer interactive interface to manage and manipulate the 
robot remotely. 

Index Terms - Map Reconstruction , DSmT, Self-localization, 
Hough transformation . 

I. Introduction 

The exploration in entirely unknown environment for 
intelligent mobile robots has been a popular and important 
subject. Map reconstruction is a very important part in this 
subject. Presently, mainly there are three mapping methods: 
grid map, geometrical feature map and topological map. Grid 
map is the most simple and popular method among them. 
There are many reports about it, for example, Elfes, and 
Moravec (1985) [1] firstly represented the probability of the 
grid occupied by obstacles with probability theory, which was 
called as occupancy grid method later [2]. It is very popular 
since its simpleness in realization and low amount of 
computation, while it has low precision in map reconstruction. 
Giuseppe Oriolo et al. (1997) [3]firstly proposed a method of 
map reconstruction based on fuzzy logic, which has high 
precision in loose environment, while it spends more time in 
the same environment than that with occupancy grid method. 
Daniel Pagac (1996) [4] firstly applied DST [5] to map 
reconstruction for mobile robots, where Dempster’s 
combinational rule is used to redistribute the belief mass of 
grid occupancy reasonably. However, it has a fatal 
shortcoming that it can’t deal with the highly conflictive 
information. Weihua Wang et al. (2003) [6] proposed a new 
grid method based on grey system theory, which has a high 
precision and moderate amount of computation, while its 
detecting range is very small. We proposed to apply DSmT[7] 
to grid map reconstruction in 2006 [81 [9], though it has 



overcome the shortcoming of DST[10][11], its precision still 
need to be improved further, since it didn’t consider 
redistributing the conflicting mass with PCR rule [12] or 
other rules, and even didn’t yet consider the self localization. 
In this paper we give a further research on map reconstruction 
based on DSmT (i.e. DSmC and PCR5 rules) and Fast-Hough 
Self-Localization in a static environment. 

This paper is organized as follows: In section II, Simple 
review of DSmT. In section III, A model based on DSmT 
with sonar information is given. In section IV, A new self 
-localization based on Fast-Hough transformation is 
proposed. In section V, A simulation experiment is done to 
testify the performance of new tool in map reconstruction 
under self localization. At last, a conclusion is reached in 
section VI. 

II. Review of DSmT 

DSmT (Dezert-Smarandache Theory) [7]is a new, general and 
flexible theory of information fusion, which can solve the 
fusion problems of different tiers including data-tier, feature- 
tier and decision-tier. It not only can dispose the static 
problem of fusion, but also can dispose the dynamic one. It 
has a prominent merit that it can deal with the highly 
conflicting information according to Proportional Conflict 
Redistribution rule no. 5 (PCR5)*, which goes backwards on 
the tracks of the conjunctive rule and only redistributes 
proportionally the partial conflicting masses to the sets 
involved in the conflict by considering the conjunctive normal 
form of the partial conflict[12]. 

A. Basic of DSmT 

1) Let © = {0 1 ,0 2 ,---,0 M } , here © is a frame of 
discernment, which includes n finite focal elements 
0 i (/ = 1, • • • n) . Because the focal element is not precisely 
defined and separated, so that no refinement of © in a new 
larger set © re ^ of disjoint elementary hypotheses is possible. 

2) The hyper-power setD @ is defined as the set of all 
compositions built from elements of © with U and Cl 

( © generates D @ under operators U and f| ) operators such 
that 

a) <j>, 0\ , 0 2 , $3 • • • 0 n e D H 



* Dezert and Smarandache have proposed 5 versions of proportional conUict 
redistribution rules, which become one part of DSmT. 
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b) If A,BeD® , then AftBeD® and A\jBeD & 

c) No other elements belong to D® , except those 
obtained by using rules a) or b). 

3) General belief function and Plausibility function 
Let © = ty\ 9 G 29 mmm ,& n } i s ti ie general frame of discernment. 
For every evidential source S, let us define a set of map of 
/?/(•) :D 0 e [0,1] associated to it (abandoning Shafer’s model) 
by assuming here that the fuzzy/ vague/ relative nature of 
elements 0 t (i = 1,2,3 •••/?) can be non-exclusive, as well as no 
refinement of © into a new finer exclusive frame of 
discernment ® ref is possible. The mapping m() is called a 



generalized basic belief assignment function (gbbaf), if it 
satisfies 

»W = 0 and £^44)=! 

The general belief function and plausibility function are 
defined respectively in almost the same manner as within the 
DST, i.e. 

(1) 

PI{a)= ^ m(B ) ( 2 ) 

BnA±0,BeD® 

4) Classical (free) DSmT rule of combination 
Let M f (o) is a free model of DSmT, and then the classical 



(free) DSmT rule of combination for k > 2 sources is given as 
follows: 



VA *<j> eD®, 



= Z rh w 

X u -X K eD® 1=1 
(X 1 n---X K )=A 



(3) 



B. Proportional Conflict Redistribution Rule 

PCR5 fines the conflicting mass, and just redistribute the 
partial conflicting mass to the elements involved in the partial 
conflict in order to improve the quality of fusion [12]. 

Here we introduce the PCR5 formula for s = 2 sources: 



VX e G/{ '</>}, 



m PCR5 (x) - tn l2 (x) + 

m 2 (X f mjr) 
x} |_wi(x) + w 2 (y) + m 2 (x)+m 1 (7) 



(4) 



c{Xf)Y)=</> 

where, c{x ) represents 



the canonical form of 



X, m X2 (f) corresponds to the conjunctive consensus, i.e. 



' alld Where 311 denominators 

x,nx 2 

are different from zero. If a denominator is zero, that fraction 
is discarded. Please see also [10], if s > 2 . 



• r Modeling for Sonar Grid Information 



Sonar sensors’ working principle (shown in Fig. 1) is: 
producing sheaves of cone-shaped wave, and detecting the 
objects by receiving the reflected wave. Due to the restriction 



of sonar physical characteristic, metrical data behaves out 
uncertainty as follows: 

a) Beside its own error of making, the influence of 
external environment is also very great, for example, 
temperature, humidity, atmospheric pressure and so on. 

b) Because the sound wave spreads outwards in the 
form of loudspeaker, and there exists a cone-shaped angle, we 
cannot know the true position of object detected among the 
fan-shaped area, with the enlargement of distance between 
sonar and it. 

c) The use of lots of sonar sensors will result in 
interference each other. For example, when the /th sonar gives 
out detecting wave towards an object of irregular shape, if the 
angle of incidence is too large, the sonar wave might be 
reflected out of the receiving range of the /th sonar sensor or 
also might be received by other sonar sensors. 

d) Because sonar sensors utilize the reflection principle 
of sound wave, if object absorbs very heavy sound wave, the 
sonar sensor might be invalid. 




Fig. 1 The sketch of the principle of sonar 



A . Modeling Based on DSm T 

Pointing to the characteristics of sonar’s measurement, we 
construct a model of uncertain information acquired from grid 
map using sonar based on DSmT. Here we suppose there are 
two focal elements in system, that is © = ^ here 6\ 

means grid is empty, 0 2 means occupied, and then we can 
get its hyper-power set D® = C\6 2 ,6 X ,6 2 ,0 X U# 2 } • Every 

grid in environment is scanned k > 2 times, each of which is 
viewed as source of evidence. Then we may define a set of 
map aiming to every source of evidence and construct the 
general basic belief assignment functions (gbbaf) as follows: 
m(6 x ) is defined as the gbbaf for grid-unoccupied (empty); 

m{0 2 ) is defined as the gbbaf for grid-occupied; m(6 x C\0 2 ) 
is defined as the gbbaf for holding grid-unoccupied and 
occupied simultaneous (conflict). m(0 x \J0 2 ) is defined as 
the gbbaf for grid-ignorance due to the restriction of 
knowledge and experience presently (here referring to the 
gbbaf for these grids still not scanned presently ), it reflects 
the degree of ignorance of grid-unoccupied or occupied. 

The gbbaf of a set of map [o,l] is constructed by 

authors such as the formulae (5) - (8) according to sonar 
physical characteristics. 

m{9 x ) = E(p).E{e) = 

L(p/R-^).(l-l/2) if <5) 

! 0 otherwise 
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n(e 2 )=(i P Yie)= 

exp(- 2p (p- R) 2 )• X if (6) 

H HwKF ’ ’ J \ o < 0 < 6)/2 

0 otherwise 

niO x n 0 2 )= 

\(\-(2(p-(R-2 S) )/Rf) if (?) 

[ 0 otherwise 

m(0 l \J0 2 ) = 

jtanh ( 2 (/> - R ))- (l - l) if (§) 

[ 0 otherwise 

,f 0sMs ‘ !| ' 2 (*> 

[ 0 otherwise 

where E(d)=\-l/2 , O(d) = 1 , E(p)= (l - (p/R - 2 ef) , 
o(p) = exp(-3p v (p-R) 2 ), where X is given by (9) (also see 
ref. [1] for justification). 




p(m) 

Fig. 2 m(.) as function of p given by formulae (5—8) 

From Fig.2 we can see that gbbaf reflects really the 
characteristics of sonar information with the shift of p in the 
course of grid map reconstruction. Here we assume the 
detecting range of sonar sensor from 0.2m~3m. High 
conflictive information happens about at the point of 
intersection of two curves between m{0 x ) and m (< h)- The 
maximum m(@ 2 ) happens at p=1.5m, while the maximum of 
m{6 x ) happens at R min =0.2m. In order to satisfy the definition 
of DSmT, and assure the sum of all mass of /w(-) to be one, 
we must renormalize them while acquiring sonar grip 
information. 

IV. Fast-Hough Self-Localization 

A. The Principle of Fast-Hough Transformation 

It is well known that classical Hough transformation plays an 
important role in picking up straight line feature since it was 
proposed by Duda and Hart in 1972 [13]. However, it doesn’t 
satisfy the real-time requirement in self - localization due to 
the high amount of computation. We here put forward an 
improved Fast-Hough transformation. 



The basic principle is when mobile robot moves to a certain 
position, we cluster all scanned points in the detecting range 
of laser range finder (0-180 degrees), and classify them into 
subset*^ (/ el,2--*). Supposed that there are n points in the 
subset S i , then compute respectively the slope between every 
two points. Setting up a counter, if the slope is in the setting 
range, we add one on the counter. When finished the statistic 
of all points in the subsets, , we classify all points having the 
maximum number to support a certain slope into a new 
subset S ? . We can pick up the straight line / y ;G ( 12 ...)through 
Hough transformation and then find those points owning the 
sub maximum number and put them into another subset Sf . 
Also pick up the second straight line until the number to 
support a certain slope is lower than the threshold. The 
mentioned above is the key difference from other Fast 
transformation methods [14]. Then we begin to deal with 
another subset S - by same way until we finish all points 

scanned in the detecting range of laser. By doing this we not 
only reduce the complexity and amount of computation, but 
also improve the precision of picking up straight line, as well 
as find smaller features which might be omitted by other 
Hough transformation methods. 

B. Self- localization of Robot's Pose 

In a static and structured environment, if we don’t consider 
the small accumulative error and metrical error, then the 
coordinate of whole object outline in the environment 
detected by laser range finder on mobile robot will be 
consistent completely with the real one in global coordinate 
system. In fact, it is impossible because of inaccurate robot’s 
pose. So robot’s pose must be calibrated. Of course, if mobile 
robot runs in the dynamic or non-structured environment, it is 
very difficult to pick up some straight line features only using 
Hough transformation method. In this case we must consider 
mixing with other effective ways [15]. 

In our research the main idea about self-localization of mobile 
robot with Fast-Hough transformation method is Step- by - 
Step mode. That is, when mobile robot moves a step, its pose 
can be calibrated with the referenced straight line and gets a 
new pose. According to the new pose calibrate some new 
straight line segments detected and choose some of them as 
the new referenced straight lines, and so on. 

In order to compare lines in the course of self calibration we 
define some attributes about a line, i.e. Line :(p h @,nj,sp, 
ep,dir,d) shown in Fig.3. Where p t is the distance OP 
between the origin O and the feature straight line AB . 6 is 
the angle of inline between the perpendicular OP and the 
positive direction of axis X (0-360 degrees), n is the point 
number including all points which may be fitted into a 
feature straight line, sp is the starting point of feature straight 

line AB . ep is the endpoint, dir is the observation direction 
relying on the location between robot and feature straight line 
AB i.e. dir = sign{p t -xqos(Q)~ ysm(6)) , where sign is 
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the Sign function. If robot is nearer the origin than the feature 
straight line, then dir = 1 ; if robot is farther away from the 
origin than the feature straight line AB , then dir = -1 ; if robot 
lied on the feature straight line, then dir = 0 . d is the 
distance between robot and feature straight line. 




In order to justify whether a feature straight line is similar to 
another one we must propose the following four necessary 
conditions. 

(a) Justify whether the observation direction is consistent. 

(b) Whether the intersection angle of two feature straight lines 
is smaller than a setting threshold. 

(c) Whether the distance from the endpoint of one line 
segment to another feature straight line is smaller than a 
setting threshold. 

(d) Justify whether two lines are independent by projecting 
line segment 1 to line segment 2. If the projective line 
segment lias a common part with line segment 2 the two 
line segments might be not independent. 




A. Both lines are similar B. Both lines aren’t similar 




C. Both lines aren’t similar D. Both lines aren’t similar 

Fig. 4 Some examples about the similarity between two straight lines 

We give several examples to justify whether a feature straight 
line is similar to another one according to the aforementioned 
conditions. For example, two feature straight lines are similar 
in Fig.4.A. The two feature straight lines aren’t similar in 
Fig.4.B, C and D because B satisfies condition (d) and 
doesn’t satisfy condition (c), C doesn’t satisfy 
condition(b)and (d), D doesn’t satisfy condition (b) and (c). 

In general, there are two main processes in the course of self 
localization, one is the mergence of line segments and the 
other is calibration of robot’s pose which isn’t independent 
each other. 

1) The mergence of line segments 



When mobile robot moves along a very long wall which is 
out of the range of laser, thus the laser range finder can’t 
detect the whole wall in one time. In this case, the mergence 
between new line segment and the old one is very necessary. 
We must justify whether the two line segments are on the 
common line according to the similar conditions. The simple 
way to merge two line segments is shown in Fig.5. To extend 
the referenced straight line we first project the new detecting 
straight line AB to the relative referenced line EF and then the 
two endpoints of projection line segment CD can be reached. 
After a simple sort of four endpoints (C, E, D, F) justify 
whether the distance CM is bigger than EM, here M is the 
midpoint of referenced line segment EF. If yes, then we will 
extend EF to point C, and get the new line segment CF. In 
this course we must consider the process of self calibration 
because correct pose is the key of merging two line segments. 

B 




Fig.5 The mergence of two straight line segments 

2) Self calibration 

Suppose the initial localization of mobile robot is correct, 
then the detecting feature straight lines are taken as the 
referenced straight line (generally speaking we choose one or 
several longer straight lines) and add them into the historical 
list of referenced straight line which is the real outline of the 
object in the environment theoretically. When robot moves a 
bit, get some old feature straight lines near referenced lines 
which might coincide completely or partially with these 
referenced straight lines. Then compute the deviation angle 
and distance between the new detecting line segment and the 
corresponding referenced one and calibrate the robot’s pose. 
At the same time we also get some new feature straight lines 
and calibrate them according to new pose of robot. At last 
choose new longer straight lines and add them into historical 
list of referenced lines, and so on. Thus the robot is able to 
finish the task of self-localization in a perfect environment. 

V. Simulation Experiments 

The experiments consist of simulating the autonomous 
navigation for Pioneer II Robot with 16 sonar detectors and a 
laser range finder. The map reconstruction with sonar sensors 
on the mobile robot is built in a static environment shown in 
Fig.6 using SRIsim simulator supplied by ActivMedia 
Company. In general there are some different outlines such as 
circle, rectangle, and triangle. The experiments based on the 
improved Fast Hough transformation are done in our 
developed platform for intelligent perception fusion system. 
The platform developed using Visual C++ 6.0 and OpenGL is 
a client end shown in fig.7 which can connect the server end. 
When the virtual robot runs in the virtual environment the 
server end can collect a lot of information from the SRIsim 
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including the location of robot, sensors reading, velocity etc. 
By the protocol of TCP/IP the client end can get any 
information from the server end. The Pioneer II Robot may 
begin to run at arbitrary location. Suppose the beginning 
location is of 300mm in X direction and 2300mm in Y 
direction with 0 degree angle the robot faces to. Using grid 
method and our improved method we get the original 
environment and reconstructed map as shown in Fig. 6 and 
Fig.7 respectively. 
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Fig. 6 The static environment in SRIsim simulator 
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Fig.7 The platform for intelligent perception fusion system 



To describe the experiment clearly, the main steps of 

procedure are given as follows. 

1) Initialize the parameters of robot including initial location, 
moving velocity, etc. 

2) When the robot is running, acquire 16 sonar readings, 
laser reading and get new robot’s location and calibrate it 
with Fast-Hough transformation described in detail in 
section IV. (Here we set the first time stamp, its 
measurement period used in our experiments is 100 ms) 

3) Compute gbbaf of the fan-form area detected by each 
sonar sensor according to formula (5) to formula (8). 

4) Whether some cells are scanned renewedly by sonar 
sensors (same sonar in deferent location, or different sonar 
sensors, of course, here we suppose each sonar sensor has 
the same characteristics)? If yes go to next step, otherwise 
go to step 6. 

5) According to the combination rule and the PCR5 in 
formulae (3) and (4) respectively we can get the new basic 



belief masses and redistribute the conflict mass to the new 
basic belief masses. 

6) Compute the credibility of occupancy bel(0 2 ) of some 
grids which have been fused according to formula (1). 

7) Update the map of the environment. (Here we set the 
second time stamp, its measurement period used in our 
experiments is also 100 ms) Whether the map 
reconstruction has been finished? If yes stop the mobile 
robot and exist. Otherwise go to step 2. 




Fig. 8 Map reconstruction with DSmT under self localization 

Finally we reconstruct the map shown in the Fig.8 with the 
new tool. It can be concluded that: 

1) From the Fig.8 we can see that the new tool has a better 
performance in building map (i.e. more distinct outline 
including circle, rectangle, and triangle) than just using 
the method of DSmT[8][9], because of considering the 
conflict factor and redistributing the conflict masses to 
other basic belief masses according to the PCR5. 

2) The restrained spreading arithmetic overcomes the 
shortcoming of the global grids which must be reckoned 
once for sonar scanning every time and improves the 
validity of calculation. 

3) Due to adopting the self localization based on fast - 
Hough transformation, the map built on-line can be 
revised real-time. Moreover, this approach of self 
localization overcomes the shortcoming of high 
computation amount and low precision of localization 
with classical Hough transformation. Of course this 
approach also has some limitations including high 
requirements for environment, a lot of feature straight 
lines needed, no or less dynamic disturbance and so on. 

4) The reconstructed map has higher precision with the new 
tool. Shown in Fig.8 we can see that there are still many 
noises in the map. So we are considering a new tool 
coupling with other information filters as a pretreatment to 
reduce the noises and improve the quality of map. 

VI. Conclusion 

In this paper we present a new tool to reconstruct map for 
autonomous mobile robot running in a static environment. 
These outline features including circle, rectangle, and triangle 
can be reconstructed clearly. This new tool provides an 
approach for studying autonomous navigation of mobile robot 
or unmanned land vehicle (ULV) in unknown environment, 
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also provides a human-computer interactive interface to 
manage and manipulate the robot remotely. The mentioned 
method of self localization overcomes some shortcomings of 
classical Hough transform. However it is difficult to 
overcome the natural shortcoming of needing lots of feature 
straight lines. So we must mix it with other methods in 
complex environment. Since the PCR6 fusion rule proposed 
recently by Martin and Osswald [16] lias already been shown 
in another application more efficient than PCR5 and many 
other classical fusion rules (i.e Dempster’s rule[5], Dubois & 
Prade’s rule [17], etc). We are carrying out a further research 
on DSmC rule coupled with PCR6 and considering 
information filters as a pretreatment task in order to reduce 
the dynamic noises and improve the quality of map. 
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